#include <Wire.h>
#include <Adafruit_MotorShield.h>
#include <MotorShield.h>

MotorShield ms1 = MotorShield(3,4,1,2);

void setup()
{
	Serial.begin(9600);	
	Serial.print("Motor Shield DEMO");
	Serial.println();
	Serial.println();
	
	ms1.begin();
	ms1.setDebugOn();
	
	Serial.print("Testing motors...");
	Serial.println();

	ms1.testMotor(1);
        delay(4000);
        
	ms1.testMotor(2);
        delay(4000);
        
	ms1.testMotor(3);
        delay(4000);
        
	ms1.testMotor(4);
        delay(4000);

}

void loop()
{
	ms1.moveForward(128);
	delay(1000);
	ms1.stop();
	delay(1000);	
}